/*
 * Copyright (c) 2010, Jim Hollinger
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *   * Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *   * Redistributions in binary form must reproduce the above copyright
 *     notice, this list of conditions and the following disclaimer in the
 *     documentation and/or other materials provided with the distribution.
 *   * Neither the name of Jim Hollinger nor the names of its contributors
 *     may be used to endorse or promote products derived from this
 *     software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 */

#include <stdlib.h>
#define _USE_MATH_DEFINES
#include <math.h>

#include "debughelper/debughelper.h"
#include "nmea0183rmc.h"

#if !defined (KNOTS_TO_METERS_PER_SECOND)
#  define KNOTS_TO_METERS_PER_SECOND     (0.514444444F)
#endif


using namespace nmea0183;


Nmea0183RMC::Nmea0183RMC() {
    messageType         = "RMC";
    time_s              = 0.0;
    latitude_degN       = 0.0;
    longitude_degE      = 0.0;
    course_rad          = 0.0;
    speed_mps           = 0.0;
    magneticVariation_rad = 0.0;
    gpsType             = 0;
}

Nmea0183RMC::~Nmea0183RMC() {}

// $GPRMC,123519,A,4807.038,N,01131.000,E,022.4,084.4,230394,003.1,W*6A
bool Nmea0183RMC::parse(const char **params, int numParams) {
    bool flag = false;

    if (((numParams - 1) == 11) || ((numParams - 1) == 12)) {
        if (nmeaUtcTimeToSeconds(params[1], &time_s)) {
            if (nmeaLatitudeToDegN(params[3], params[4], &latitude_degN)) {
                if (nmeaLongitudeToDegE(params[5], params[6],
                    &longitude_degE)) {
                    speed_mps =
                        static_cast<float> (strtod(params[7], NULL) *
                                           KNOTS_TO_METERS_PER_SECOND);
                    course_rad =
                        static_cast<float> (strtod(params[8], NULL) *
                                           M_PI / 180.0);
                    magneticVariation_rad =
                        static_cast<float> (strtod(params[10], NULL) *
                                           M_PI / 180.0);
                    if (params[11][0] == 'W') {
                        magneticVariation_rad = -magneticVariation_rad;
                    }
                    flag = true;
                    if (params[2][0] == 'A') {
                        if ((numParams - 1) == 12) {
                            if (params[12][0] == 'E') {
                                gpsType = 6;
                            } else if (params[12][0] == 'D') {
                                gpsType = 2;
                            } else {
                                gpsType = 1;
                            }
                        } else {
                            gpsType = 1;
                        }
                    } else {
                        gpsType = 0;
                    }
                }
            }
        }
    }

    return flag;
}
